#include "stm32f10x.h"                  // Device header
#include "Delay.h"
#include "key.h"
#include "oled.h"
#include "PWM_SERVO.h"
int16_t Compare=0;
int16_t i=0;

int main(void)
{
	KEY_Init();
	SERVO_Init();
	OLED_Init();
	while(1)
	{
//		 if(Key_s(GPIOC,GPIO_Pin_13)==1)
//		{
//	    	i++;
//		}
//		 else if(Key_s(GPIOA,GPIO_Pin_0)==1)
//		{
//	    	i--;
//		}
//	   switch(i)
//	   {
//		   case 1:Compare=500;break;
//		   case 2:Compare=1000;break;
//		   case 3:Compare=1500;break;
//		   case 4:Compare=2000;break;
//		   case 5:Compare=2500;break;
//	   }
//		if(i<=0||i>5)
//		{
//			i=0;
//		}
		
		
		
	 if(Key_s(GPIOC,GPIO_Pin_13)==1)
		{
	    	Compare+=45;
			if(Compare>180)
			{
			  Compare=0;
			}
		}
		 if(Key_s(GPIOA,GPIO_Pin_0)==1)
		{
	    	Compare-=45;
			if(Compare<0)
			{
			  Compare=0;
			}
		}
          Set_Servo(Compare);
//		Set_Compare2(Compare/180*2000+500);
		OLED_ShowSignedNum(1,2, Compare,5);
		
	}
}
